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>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>> 

J. 

> Module: Math 

J. 

> BANK 1 hODULE 

> 

> This module contains a 1 1 the special purpose math routines 

> used in the Widget firmware. 

> 

> FUNCTION Diu3_19< fl : 3 BVTES { lrC:E > ) : 3 BVTES { !r0:2 > 

> FUNCTION Div3J38< fl : 3 BVTES { !rC:E } > : 3 BVTES { !r0:2 } 

> FUNCTION 0iv3_75<: fl : 3 BVTES { !rC:E > > : 3 BVTES { !r0:2 > 

> FUNCTION HulRO_m< RO : BVTE OK3 } > : 3 BVTES < !r0:2 } 

> FUNCTION DiMHdsSctrs< fl : 3 BVTES { !r0:2 } ) : 

> Quotient : BVTE { !rO:1 > 

> Remainder : BVTE { IrS } 

> FUNCTION DIvSctrsC fl : BYTE { !r3 > > : 

> Quotient : BVTE { !r2 > 

> Remainder : BVTE { Ir3 > 
> 

>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>> 
. LSTOFF 
.FIN 

-DO External 

.LSTON 
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>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>> 
> 

> Function: DiM3J«., DiM3_19, D{y3^38, DiM3_75 

> This function performs the following 24 bit arithmetic operations: 
> 

> DIm3_19 : Result <— R OIU 19 

> 

> Div3_76 : Result <— fi DIU 76 

> Inputs: 

> fl: 3 BS'TES { !rC, IrD, !rE > 

> 

> Outputs: 

> Result: 3 BVTES { !rO, !r1, Ir2 > 
> 

>:>>>>:>>>>>>>>>>>>>>>>>>>>>>>>>> 
.LSTOFF 
.FIN 

.DO Internal 

.LSTON 
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.FIN 

>>>>>>>>>>>:>>>>>>>>>> 
> 

> Div3_19: Quotient := DiMidend DIM 19 

> 

> Local Uariables: 

> Divisor : 3 WTES { !rC:E > 

> Quotient : 3 BVTES { !r7:9 > 

> Dividend : 3 BVTES { Ir4:6 > 

> ■ 

> BEGIN 

> Divisor := $013000 { 19 * 2'< 13 - 1 > > 



> Ooutlent := 

> FOR 1 := 1 TO 13 DO 

> IF < Dividend >= Divisor > 

> THEM 

> Dividend := Dividend - Divisor 

> Quotient := < Quotient * 2 > + 1 

> ELSE Quotient := < Quotient * 2 > 

> Divisor := Divisor DIU 2 

> END 
^ > 

;>>>>>>>>>>>>>>>>>>>>> 



niu3 76- 


i r! 






Ld 


ScrRegD,«$CO 




Ld 


ScrRegE,«$00 






n i 1 V 

U 1 Vi3_X 


Dlv3_38: 


Ld 


ScrRegC,«$02 ;DI visor := $025000 
















Jr 


Dlv3_x 


Diy3_19: 


Ld 


ScrRegC,*$01 jOi visor := $013000 




Ld 






i ri 




Div3_>«: 


Ld 


ScrReg4, !rC ;pciss dividend to routine 




Ld 


ScrRegS, !rD 




Ld 


<^r-r-R«infi I i^F 
'^wi ritsyu ^ : f ^ 




1 USI 1 






or jj 






CIr 


!r? ;Quotient := 




w 1 1 


ir-R 
: r o 




r 1 r- 

Lr 1 i 


: r 13 






!rfi,«13 ; FOR i := 1 TO 13 DO 


Diw3 1Q { n- 








Rfc- 


?rQ .Quotient := Quotient * 2 




RIc 


!r8 




RIc 


!r7 






I K-n f r-d 'IP f n i ij i HanH > = H i i j i •erni^ "J 
ifWjiir** f ^ uivi utsr lu ' ~ u I V i a-ur ^ 




i ri 


i r- 1 i 

: 1 1 . I r vJ 




Ld 


!r2, !r6 




Call 


Sub3 




Jr 


C.Div3_19_Div2 




Ld 


Ir4. IrO ; Dividend := Dividend - Divis 




Ld 


!r5, !r1 




Ld 


!r6, !r2 




Rdd 


lr9,*1 ; quotient := quotient + 1 




Rdc 


!r8,«0 




fldc 


!r7,«0 


Div_3_19_Djv2: 


Rcf 


; clear carry flag 




Rrc 


!rC ;D{visor := Divisor DIU 2 




Rrc 


IrD " 




Rrc 


IrE 



D j nz ! rft , D I y 3_ 1 9_Lp 

Pop Rp ; con text switch 

Ld !r0j,ScrReg7 ;pass quotient to caller 

Ld I r 1 . ScrReg8 

Ld ! r2, ScrRegQ 

Jp Bank-Ret 

.LSTOFF 
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>>>>>>>>>>>>>>>>>>>>>>>>> 
> 

> Function: riulRO_m { Multiply RO by a > 

> 

> This function muliplies the byte in IrO by in where: 



> 


For lOMbyte 


Prof i 


le: m 




256 




For 20nByte 


Prof i 


te: m 




512 


> 

> 


For SOMByte 


Prof i 


le: m 




1024 




Inputs: 












fl : 


BVTE 


{ IrO 


> 





Outputs: 

Result : 3 BVTES { !rC, IrO, !rE > 



>>>>>>>>>>>>>>>>>>>>>>>>> 
.FIN 



.DO Internal 

.LSTOM 

.FIN 



nulRO_iB: 



CIr 


IrE 


Ld 


!rD, !rO " 


CIr 


IrC 


.LSTOFF 




.DO 


M-20MB + 


.LSTON 




RIc 


IrE 


RIc 


IrD 


Rlc 


!rC 


.LSTOFF 




.FIN 




.DO 


W_40NB 


.LSTON 




RIc 


IrE 


RIc 


IrD 


RIc 


!rC 


.LSTOT 




.FIN 




.DO 


Internal 


.LSTON 




.FIN 




Jp 


Bank_Ret 



.Result := IrO * 256 



Result := Result * 2 



; Result := Result * 



.LSTOFF 

.DO External 
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>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>> 
> 

> Function: DiyHdsSctrs { DiMide by Heads * Sectors } 

> 

> This function takes the 24 bit word passed to it and returns 

> a 2 byte integer < representing the cylinder number > and 

> the remainder from the divide. 

> 

> Inputs: 

> fi : 3 BVTES { !rC, !rD, IrE } 

> 

> Outputs : 

> Cylinder : WORD { !!rO > 

> Remainder : i BVTE { !r3 > 

> 

>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>> 
.LSTOFF 
.FIN 

.DO Internal 

.LSTOh 

.FIN 



DlMHdsSctrs; 



.DO u_ioriB 

Ca I I i v:3_J38 ; re turn w i th ! rO : 2 = resu 1 1 

; ScrReg4:5 = remainder 

.FIN 

.DO M_20I1B + W_40t1B 

Call DiM3_76 ; re turn with Ir0:2 = result 

; ScrReq4:& = remainder- 

.FIN 



Ld IrOJrt ;HiCyl := .. 

Ld !r1,lr2 ;LoCyl := .. 

Ld fr:3^ScrReg& ; Remainder := . . 

Jp Bank_Ret 



.LSTOFF 

.00 External 
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; >>>:>>>>>>>>>>>>>>>>>>>>>>>>>>>> 
• > 

;> Function: DivSctrs { Divide by Sectors } 

; > 

;> This function takes the 1 byte word passed to it and returns 

;> a 1 byte integer < representing the head number ) and 

;> the remainder from the divide < the remainder is the sector * >. . 

; > 

;> Inputs: 

;> fl : 1 BVTE { !r3 } 

;> Outputs: 

;> Quotient : 1 BVTE { !r2 > 

;> Remainder : 1 BVTE { !r3 ) 

; > 

;> filgorithro: 

;> 



and 



Mote that there are only 2 ^leads on the widget, therefore 

if fi > NufflberOf Sec tors then Head := 1, eise Head ;= 

if fl > NumberOf Sec tors then Sector := fl - NumberOf Sec tors 

else Sector := fl 
fllso_, the sector is logically remapped to account for 
different inteaved drives. The mapping table is located 
in the SpareTable: when the physical sector is found it's 
value is used as an index into the Map-Table and the value 
stored at that location of the table becomes the new sector. 



>>>>>>>>>>>>>>>>>>>>>>>>>>>>>> 
. LSTOFF 
.FIM 

-DO Internal 
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.FIM 



DivSctrs: 



Ld 

Cp 
Jr 

Ld 

Sub 

.Jr 



!rO,»NbrSctrs ; load number of sectors Into !rO 
; check for fi greater /equal 



!r3, !rO 
Lt.DJSctrsI 

!r2,«l 
!r3, IrO 
D_Sctrs2 



select head 1 



DJBctrsI: 
DjSctrs2: 



CIr 
Ret 



Ir2 



; select head 



ReMapjSector: 



Push IrE ;save regs 

Push IrF 

Ld !rE,».HlBVTE. napjfable 

Ld lrF,«.LOUBVTE. Map-Table 

Add IrF, IrO ; index into table 

fldc ?rE,«0 

Lde lrO,@!!rE ;get remapped sector 

Pop IrF 

Pop IrE 



Jp 



Bank_Ret 



.LSTOFF 



